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Description 

Method For Estimating The Mass Of A 
Vehicle Which Is Being Driven On A Road 
With A Varying Gradient And Method For 

Estimating The Gradient Of The Road 
Upon Which The Vehicle Is Being Driven 

Cross Reference to Related Applications 

[0001] The present application is a continuation patent applica- 
tion of International Application No. PCT/SE02/01476 
filed 19 August 2002 which was published in English pur- 
suant to Article 21(2) of the Patent Cooperation Treaty, 
and which claims priority to Swedish Application No. 
0102776-2 filed 17 August 2001. Both applications are 
expressly incorporated herein by reference in their en- 
tireties. 
Background of Invention 



Technical Field 



[0002] The invention relates to a method for estimating the mass 
of a vehicle which is being driven on a road with a varying 
gradient according to the preamble to Claim 1. The inven- 
tion also relates to a method for estimating the gradient 
of the road on which the vehicle is being driven according 
to the preamble to Claim 13. In particular, it relates to a 
method for simultaneously estimating the mass and the 

gradient of the road on which the vehicle is being driven. 
Background Art 

[0003] | n order to ensure that a vehicle's movement patterns can 
be controlled in a satisfactory way, reliable information for 
controlling the vehicle's transmission line and braking 
system must be available. It is of the greatest importance 
that reliable information is available regarding the vehi- 
cle's mass, its speed and the gradient of the road. 

[0004] a normally used method for simultaneously estimating a 
vehicle's mass and the gradient of the road on which the 
vehicle is being driven is to calculate the vehicle's acceler- 
ation at two adjacent moments in time, which are typically 
within an interval of 0.5 seconds. By this means gravita- 
tional forces, roll resistance and air resistance can be as- 
sumed to be constant. By utilizing Newton's second law, 
at said two measurement points, the vehicle's mass, which 



is the only unknown parameter in the equation once the 
acceleration has been calculated, is calculated from mea- 
sured data concerning the speed at said two measurement 
points. The measurement signal concerning the vehicle's 
speed is normally noisy. In order to obtain a relatively 
good estimate of the vehicle's acceleration from the noisy 
speed signal, it is important that the difference in speed 
should be relatively large in spite of the short interval be- 
tween the measurement points. One way of obtaining this 
is to move one measurement point to a time immediately 
before changing gear and the second time to immediately 
after changing gear. However, there are a number of 
problems associated with this method. Firstly, this 
method requires the measurement to be carried out dur- 
ing difficult conditions as oscillations arise in the trans- 
mission line due to the flexibility of the transmission line 
and, where applicable, the play in the coupling between 
the tractor unit and trailer. The oscillations are stimulated 
by the driving force being discontinuous during the gear 
changing procedure. In addition, this method cannot be 
used if the vehicle is equipped with a gearbox of the so- 
called "power-shift" type where the power from the en- 
gine is not disconnected during a gear change. 



[0005] Another type of commonly occurring gear box is an auto- 
matically-controlled manual gear box, where the actual 
gear change procedure is controlled by an actuator after 
the gear position has been selected by the driver. In these 
gearboxes, the gear position is detected by a sensor after 
which a control signal to the actuator effects the gear 
change. With this type of gear box, it is possible to carry 
out the gear change procedure with good control. A prob- 
lem with changing gear, particularly while traveling up an 
incline, is that the vehicle loses speed during the gear 
change procedure as there is an interruption in the trans- 
mitted torque. This means that it is desirable to keep the 
gear change procedure as short as possible. Manufactur- 
ers of gearboxes therefore try to minimize the time for 
the gear change procedure with automatically-controlled 
manual gearboxes, which means that the time for carrying 
out an estimation is reduced, whereby the accuracy of the 
measurement is reduced. 

[0006] An example of a method which in reality requires the 
measurement to be carried out during the moment of 
changing gear is US 5549364. The reason for this is that 
no simultaneous estimation of the mass and the gradient 
of the road is carried out. This means that the estimating 



method is dependent upon two time-discrete measure- 
ment occasions. In order to manage the very noisy speed 
signal, the measurement thus needs to be carried out 
during the gear change procedure, with the abovemen- 
tioned problems as a result. 
[0007] us 6167357 describes an example of a recursive method 
for estimating the mass of a vehicle. According to the 
method described, there is a simultaneous determination 
of the vehicle's mass and an air resistance coefficient. This 
coefficient is, however, not a variable, but a constant, for 
which reason the method described cannot be used for 

the determination of the gradient of the road. 
Summary of Invention 

[0008] The object of the invention is to provide a method for es- 
timating the mass of a vehicle and/or the gradient of the 
road, which method does not require measurements to be 
carried out specifically during a gear change procedure. 

[0009] This object is achieved by a method for estimating the 
mass of a vehicle according to the characterizing part of 
Claim 1. By using a calculating device within which a re- 
cursive process generates an estimate of the weight of the 
vehicle by utilizing a statistical filter utilizing input data 
comprising the vehicle's speed and a parameter which 



comprises a horizontal force acting on the vehicle, the 
mass of the vehicle can be determined with good conver- 
gence utilizing a statistical representation of a road with 
varying gradient. 

[0010] This object is also achieved by a method for estimating 
the gradient of the road on which a vehicle is being 
driven, according to the characterizing part of Claim 13. 
By utilizing a calculating device within which a recursive 
process generates an estimate of the gradient of the road 
on which a vehicle is being driven by the utilization of a 
statistical filter utilizing said input data comprising the 
vehicle's speed and a parameter which comprises a hori- 
zontal force acting on the vehicle, the road's gradient can 
be determined with good convergence utilizing a statisti- 
cal representation of a road with varying gradient. 

[001 1] | n a particularly preferred embodiment of the invention, 
the gradient of the road on which the vehicle is being 
driven and the mass of the vehicle are determined simul- 
taneously. 

[0012] | n a preferred embodiment of the invention, a Kalman fil- 
ter or an extended Kalman filter is used as statistical filter 
in a recursive process constituting an estimating method 
for the vehicle's mass and/or gradient of the road on 



which the vehicle is being driven. The vehicle's equation 
of motion constitutes in all cases the base equation for 
the Kalman filter. 
[0013] a Kalman filter is an estimating method for linear systems 
which takes account of the statistical behavior of a pro- 
cess and measurement interference. In general, a Kalman 
filter is described by the system: 

[0014] 

x = Ax + Bu + v : y - Cx + Dy + w 

[0015] where x is a state vector, y is a measurement vector, u is a 
known system effect and v and w are interference vectors 
for process and measurement. 

[0016] An extended Kalman Filter is an estimating method for 
non-linear systems. 

[0017] a fuller description of Kalman filters is given, for example, 
in Schmitbauer B. "Modellbaserade reglersystem", stu- 
dentlitteratur 1999. 

[0018] By means of the method according to the invention, a si- 
multaneous estimation is obtained of the vehicle's mass 
and the gradient of the road on which the vehicle is being 
driven. 

[0019] | n a preferred embodiment, the statistical representation 



of the gradient of the road consists of a first order pro- 
cess with an intensity d and a switching frequency oo_. An 
estimate from a frequency range from a reference road 
can be used as the initial values of the intensity d and 
switching frequency oo . According to an embodiment of 

c 

the invention, it is however possible to update the value of 
the parameters d and uj^ by studying the variation in the 
value of the gradient of the road calculated by the process 
and inserting the most suitable value for the occasion. 
One way is to store the gradient estimate in a batch and 
then (perhaps every two hours) run a typical RLS 
(Recursive Least Square) algorithm in order to set the pa- 
rameters, that is a first order process is adapted to a 
measurement series. A fuller description of how updating 
can be achieved is given in Lennart Ljung, System identifi- 
cation - theory for the user. 
[0020] According to an embodiment of the invention, the longi- 
tudinal force component is estimated from an estimate of 
torque delivered by an internal combustion engine fitted 
in the vehicle. The estimation is carried out in a way that 
is well known to a person skilled in the art from input data 
comprising provided fuel quantity, current engine speed 
and the speed of the vehicle. An example of how calcula- 



tion of propulsion torque from vehicle data is carried out 
is given in US6035252. In an alternative embodiment of 
the invention, the longitudinal force component is esti- 
mated by utilization of an accelerometer which measures 
the acceleration in the longitudinal direction. According to 
a third embodiment of the invention, the longitudinal 
force component is estimated by a torque sensor located 
in the vehicle's transmission line. 
[0021] According to a preferred embodiment of the invention, the 
method is used for estimating the mass of the vehicle for 
dividing braking force between brakes in the vehicle's 

tractor unit and trailer. 
Brief Description of Drawings 

[0022] jhe invention will be described below in greater detail 
with reference to the attached drawings, in which: 

[0023] Figure 1 shows schematically a vehicle comprising a con- 
trol circuit for carrying out a method for estimating the 
vehicle's mass and/or the gradient of the road according 
to the invention, 

[0024] Figure 2 shows a block diagram for executing a method 
for estimating the vehicle's mass and/or the gradient of 
the road according to the invention, 

[0025] Figure 3 shows the result from simulations of estimations 



of the mass and the gradient of the road by the use of the 

estimation method according to the invention, and 

[0026] Figure 4 shows schematically a method for estimating the 

vehicle's mass and/or the gradient of the road. 
Detailed Description 

[0027] | n a fj rst model, the gradient of the road is estimated for a 
vehicle of known mass. The model is based on the vehi- 
cle's equation of motion in the vehicle's longitudinal di- 
rection. By the vehicle's longitudinal direction is meant the 
direction along the vehicle's route irrespective of at what 
angle in relation to the horizontal plane the vehicle is cur- 
rently being driven. 

[0028] The equation of motion has the form: 

[0029] 

m v — mg sina + f - f f 

[0030] where a is the gradient of the road, f the propulsion 

p 

force and f the retardation force. The propulsion force f 

r p 

comprises positive propulsion torque from an engine in 
the vehicle filtered via the vehicle's transmission. The re- 
tardation force f comprises retarding forces from wheels, 



auxiliary brakes and deterministic components of roll re- 
sistance and air resistance. 
[0031] B 0 th applied propulsion force f and retardation forces f 

P r 

are regarded as known input signals to the statistical fil- 
ter. 

[0032] v\/e have thus an input signal of the form: 
[0033] U (t) = f (t) - f (t) = f (t) 

P r 

[0034] After selection of the vehicle's speed v and the gradient of 
the road as state variables, the following state equations 
are obtained: 



[0035] 



m 



-f(f) + v x 



y = x, + w 

[0036] | n this model, a statistical representation of a road with 
varying gradient is introduced. In an analysis, the fre- 
quency range of a reference road has been measured. 
Study of the frequency range shows that the frequency 
range can be approximated with relatively good accuracy 



by a first order process. Of course, other processes of 
higher order can be used, with the result that the dimen- 
sions of the state equations increase. The studied refer- 
ence road segment shows a switching frequency of f = 

2 

0.002 cycles/m and a noise intensity of 0.8 (radians) / 
(cycles/m) 

[0037] The statistical representation is used in the above state 
equation, whereby the following state equation is ob- 
tained: 



[0038] 



x, = v=>^ = gx 2 +—f(t) + u l 

m 

x 2 = a => x 2 = a = -o) c x 2 + v 2 



0 g 
0 -a 
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v 2 



[0039] a further possibility for improving the estimate of the 

gradient of the road is obtained by an improved model of 
the interference forces, where the interference forces are 
modeled by a first order process instead of being modeled 
by white noise. 

[0040] This is possible, as the magnitude of the error in the 

propulsion and braking torque from the engine and auxil- 
iary brakes, roll resistance and air resistance is known, 
but not its frequency content. The state equation is there- 
fore extended by an additional state x = f and there- 

7 3 dist 

after has the following appearance: 
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[0042] where u> is the switching frequency of the interference 

d 

force and d is the intensity of the noise. 
[0043] | n order to make possible simultaneous estimation of the 
mass of the vehicle and the gradient of the road on which 
the vehicle is being driven, the state equation must be ex- 
tended by at least one additional state corresponding to 
the mass of the vehicle. According to this embodiment of 
the invention, the mass of the vehicle and the gradient of 
the road on which the vehicle is being driven are esti- 
mated by using an estimation of a variable which com- 
prises longitudinal force components which in this case 

correspond to applied propulsion force f and retardation 

p 

forces f together with a statistical representation of a 
road with varying gradient. The propulsion force is esti- 
mated according to an embodiment of the invention by 
input data concerning the speed of the vehicle, amount of 
fuel supplied to the vehicle's cylinders and current engine 
speed of the internal combustion engine being trans- 
formed into a value for propulsion torque of the internal 



combustion engine. This transformation between input 
data and propulsion torque is carried out in a processor in 
the vehicle in a way that is well known to a person skilled 
in the art by the utilization of calculations and mappings 
of input data into propulsion torque based on experience. 
According to an alternative embodiment of the invention, 
the propulsion torque is estimated by an output signal 
from a torque sensor placed in the vehicle's transmission 
line. The estimated torque is thereafter transformed by 
filter to a propulsion force via information concerning 
current gearing between the drive shaft from the internal 
combustion engine and the driving wheels. 
[0044] Together with the utilization of a first order model of the 
variation in the gradient of the road, according to what 
was described above, we obtain the following state equa- 
tion: 



[0045] 




m 



m 



m - x 3 - u 3 
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[0046] The equation is a non-linear state equation, for which 

reason an extended Kalman filter must be used. The state 
equation is of the form 

[0047] 



[0048] where f(x,t) is non-linear and g(x,t) is linear. By the use of 
an extended Kalman filter, the model is linearized around 
the estimate of the state vector x. Difference equations 
are preferably used instead of differential equations in 
real-time applications. Together with a Euler approxima- 
tion of the time derivative, x = (x(t+h) - x(t))/h, this gives 
a discrete state equation as follows: 



x 





[0049] 



■ l {t + l) = x l +hgx 2 +^-!- + ^- = f l 
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x 3 + hv 3 = f 3 + hv 3 

(1 - ho) d )x A + hv 4 = f 4 + hv A 



[0050] The next step is to linearize the above state equation 
around the estimate of the state vector x, whereby the 
following linear state equation is obtained: 

[0051] 
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[° 052 ] Simultaneous estimation of the mass m of the vehicle and 

the gradient a of the road on which the vehicle is being 

driven is now possible by using the above state equation 

recursively utilizing the vehicle's speed v and information 

about applied propulsion force f and retardation forces f 

p 

. The propulsion force f consists of positive propulsion 

r p 

torque from an engine in the vehicle filtered via the vehi- 
cle's transmission. The retardation forces f comprise re- 

r 

tarding forces from wheels, auxiliary brakes and deter- 



ministic components of roll resistance and air resistance. 
In order to obtain a stable approximation of the state vec- 
tor, in a preferred embodiment the process is stopped 
when the driver applies the service brake as the friction 
between the brake lining and the brake disc normally has 
great stochastic variation. 

[0053] According to a second embodiment of the invention, the 
mass of the vehicle and the gradient of the road on which 
the vehicle is being driven are estimated by using an esti- 
mation of a variable which comprises a longitudinal force 
component which in this case corresponds to an input 
signal from an accelerometer that measures specific force 
along the vehicle's longitudinal extent together with a sta- 
tistical representation of a road with varying gradient. 

[0054] | n t his case, a state variable x is introduced, which corre- 

3 

sponds to the longitudinal acceleration in the state equa- 
tion. The longitudinal acceleration is modeled with a first 
order process with a switching frequency co . We obtain a 

d 

state equation as follows: 

[0055] 
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[0056] By using the input signal aft) from an accelerometer, the 



[0057] 
[0058] 

[0059] 
[0060] 



estimation of the gradient of the road on which the vehi- 
cle is being driven can be carried out without direct con- 
nection to the mass of the vehicle. The vehicle's mass can 
therefore be estimated simultaneously by utilizing the 
control force f(t) according to the above, by the relation- 
ship a(t) = This means that when the input signal from an 
accelerometer is used, the estimation problem can be di- 
vided between two separate filters, a kinematic filter with- 
out equation of motion for estimating the gradient of the 
road and a dynamic filter concerning the mass. 
The dynamic filter's appearance for determining the mass 
is apparent from the following state equation: 



y = fit) = {a{t)-x 3 )x,+w\ A = 0 Bu=[6\ C = [(a(t)- x 3 )] u = fo] 

Figure 1 shows schematically a control system for a vehi- 
cle where the method described above can be applied for 
estimating the gradient of the road on which the vehicle is 
being driven, the mass of the vehicle, or alternatively si- 
multaneous estimation of the gradient of the road on 
which the vehicle is being driven and the mass of the ve- 
hicle. 

The control system is of the type that is described in 




patent specification US 6167357 to which reference 
should be made for a more detailed description. 

[0061] The vehicle 10 comprises an internal combustion engine 
11 and a gearbox 12 which connects the internal combus- 
tion engine 11 to a drive shaft 13 for a set of wheels 14 
via an outgoing shaft 15. The internal combustion engine 
11 is controlled by an engine control unit 16 which uses 
an input signal from an accelerator pedal 17 and where 
applicable a constant speed regulator 18. The internal 
combustion engine 11 and its engine control unit 16 are 
of conventional type where the engine control unit con- 
trols the fuel injection, engine brake, etc, according to in- 
put signals from the accelerator pedal 17, speed sensor 
19 and brake control system 20. 

[0062] The gearbox 12 is controlled according to the embodi- 
ment shown by a gearbox control unit 21 which controls 
the gear shift by the input signal from the speed sensor 
19 or alternatively from the input signal from a gear se- 
lector 22 on the vehicle. The invention can also be used 
on vehicles without electronically-controlled gearboxes. In 
an embodiment of the invention, it is, however, necessary 
to record which gear is currently being used by the vehi- 
cle. The gearbox and its control unit are of conventional 



type. 

[0063] The brake control system 20 is controlled by input signals 
from a service brake control 23 and, where applicable, an 
auxiliary brake control 24. The apportionment between 
service brake and auxiliary brake can, where applicable, 
be carried out automatically. The brake control system 
generates output signals to the engine control system 16 
for controlling the injection and the engine brake, to other 
auxiliary brakes, where applicable, for example in the 
form of a retarder 25 which is controlled by a control de- 
vice 26, and to the service brakes 27. Where applicable, 
there is a apportionment of the braking force between the 
vehicle's pairs of wheels and, where applicable, service 
brakes 33 on pairs of wheels 28, 29 on a trailer unit 30 
connected to the framework structure 31 of the vehicle 10 
via a coupling 32. 

[0064] The vehicle also comprises a calculating device 34 for es- 
timating the mass of a vehicle, for estimating the gradient 
of the road on which the vehicle is being driven, or alter- 
natively for simultaneously estimating the mass of a vehi- 
cle and estimating the gradient of the road on which the 
vehicle is being driven. 

[0065] The calculating device 34 receives input data from the 



speed sensor 19. According to an embodiment of the in- 
vention, the calculating device receives in addition infor- 
mation from an accelerometer 35 which measures the ve- 
hicle's acceleration in the longitudinal direction and uses 
this information to determine a variable which comprises 
a longitudinal force acting on the vehicle. According to an 
alternative embodiment, a variable is measured which 
comprises a longitudinal force acting on the vehicle by 
recording applied propulsion force f and retardation 
forces f . For this purpose, the calculating device uses in- 
put signals from the brake control system 20 for deter- 
mining the size of the applied braking forces, in particular 
the size of forces applied via the auxiliary brakes. In addi- 
tion, input signals are used from the speed sensor 19 to 
determine the roll resistance and air resistance. In an em- 
bodiment of the invention, information from the engine 
control system 16 is used for determining torque deliv- 
ered by the internal combustion engine. In another em- 
bodiment of the invention, the input signal from a torque 
sensor 36 placed along the vehicle's transmission line is 
used. In addition, the input signal from the gearbox con- 
trol unit 21 is used to determine the applied propulsion 
force from the calculated or measured propulsion torque. 



[0066] All the input signals to the calculating device 34 are of 

conventional type and are available via the communication 
system that is used in the vehicle, normally a data bus. 

[0067] The calculating device 34 generates output signals corre- 
sponding to the gradient of the road on which the vehicle 
is being driven 38 and/or the vehicle's mass 37, depend- 
ing upon which of the processes described above for de- 
termining the state equations determining the vehicle's 
movement has been selected. The calculating device 34 
comprises memory areas and processors whereby itera- 
tion of the recursive process can be carried out with gen- 
eration of an estimate of the gradient and/or the mass as 
a result. 

[0068] Figure 2 shows a block diagram for a process for execut- 
ing a method for estimating the vehicle's mass according 
to the invention. 

[0069] The figure describes the principal flow for simultaneous 
estimation of mass and gradient (without specific force 
measurement). The estimation/measurement of the trac- 
tive force and auxiliary braking force are not dealt with in 
detail. Nor is the signal processing (filtering, etc) of other 
measured signals dealt with in detail. 

[0070] The following designations are used for quantities in the 



estimation process. 
[0071] Area: The wind resistance area of the vehicle 

[0072] ccl; Wind resistance coefficient 

[0073] c r: r 0 || resistance coefficient 

[0074] g : Gravitation constant 

[0075] h ■ Updating time for Lthreshold 

[0076] Updating of the gradient process parameters, relatively 

long time (hours) 

[0077] h: Sampling time 

[0078] d : The intensity of the gradient process 

[0079] e: The intensity of the force interference process 

[0080] | n a fj rs t function block 40, the applied propulsion torque 
is estimated and also the calculated propulsion force from 
the estimate of the propulsion torque. In addition, the ap- 
plied braking torque and braking force from auxiliary 
brakes are estimated. Input data to the first function block 
40 consists of a set of variables including accelerator 
pedal position, engine speed, injected fuel quantity, gear 
position, turbo pressure where applicable, drive shaft 
speed and a state variable for auxiliary brakes which can 



include the air pressure in the auxiliary brakes and/or 
power supply to electrical retarders. The estimation of 
propulsion force and braking force from auxiliary brakes 
from said input data is carried out by conventional tech- 
niques well known to a person skilled in the art and will 
therefore not be explained in greater detail. The estima- 
tion of propulsion force from said given input data is de- 
scribed, for example, in Anderson B.D.O., More J. B., Opti- 
mal Filtering, Information and System Science Series. 
Prentice-Hall, University of Newcastle, New South Wales, 
Australia, 1979. 

[0081] Output signals from the first function block constitute a 
first state variable s(l) corresponding to the propulsion 
force and a second state variable s(4) corresponding to 
the braking force from the auxiliary brakes. 

[0082] These two state variables s(l) and s(4) form input data for 
a second function block 50 together with a third state 
variable s(3) corresponding to a binary value determining 
whether the service brakes are used or not, and a fourth 
state variable s(2) corresponding to the speed of the vehi- 
cle. In the second function block, the force in the vehicle's 
longitudinal direction is calculated. In a first embodiment 
of the invention, the force is calculated according to the 



following relationship: 

[0083] f( t ) = S (i) _ o.5Cd*Area s2(s) - Cr*g*s(9) - s(4) where s(9) 
is a ninth state variable corresponding to an estimated 
value of the vehicle's mass. The force f(t) constitutes a 
fifth state variable s(5). In addition, a sixth state variable 
s(6) is created that constitutes the variance of the force 
f(t) and is used as a threshold value for estimation to be 
able to take place. 

[0084] We have thus: Uhreshold(t) = variance(f(t), s(5) = f(t) and 
s(6) = Lthreshold(t). 

[0085] | n order to obtain a good estimation, it is necessary for 
the dynamic system to be stimulated sufficiently. 

[0086] | n an alternative embodiment of the invention, the calcu- 
lation of the force from output signals from the first func- 
tion block 40 is replaced by a calculation from an input 
signal from a third function block 60 where input signals 
from torque sensors are used instead of estimates based 
on other parameters. 

[0087] input signals to a fourth function block 70 consist of the 
output signals created in the second function block 50 
and a seventh state variable s(7) corresponding to the es- 
timated state vector Xest, an eighth state variable s(8) 
corresponding to the covariance matrix P(t) of the estima- 



tion error and, where applicable, updated values of the 
switching frequency oo^ and the interference intensity d. 
The state vector Xest comprises the states: speed, s(2), 
the gradient of the road s(10), the mass s(9) and the in- 
terference force. These states are given in the equation on 
top of page 10. In the fourth function block, a control is 
carried out in a first process step of whether the system is 
sufficiently stimulated for estimation to be allowed to take 
place. This is carried out by investigating whether the 
sixth state variable exceeds a particular limit value and 
whether the third state variable is equal to zero, which 
means that the service brakes are not being used. The 
condition has thus the following appearance: If s(3) = 0 
and s(6)>Threshold 
[0088] if these conditions are fulfilled, the system matrix A(t) is 
defined in a second process step, which system matrix is 
a function of s(5), s(2), h, g, w and w , and the process 

c d 

interference matrix R^t) is defined, which process inter- 
ference matrix is a function of s(2), d, and e. The system 
matrix is given by the equation given at the top of page 
11. The appearance of the functions is given under the 
above description of Kalman filtering. In addition, a mea- 
surement matrix C(t) and measurement interference ma- 



trix R 2 (t) are created, the appearance of which is also 
shown under the above description of Kalman filtering. 

[0089] Thereafter in the third process step, the Ricatti equation, 
the Kalman filter, are calculated and the state vector is 
updated. During this process step, the estimate of the 
state vector Xest(t) forms a seventh state variable s(7) and 
the covariance matrix P(t) of the estimation error forms an 
eighth state variable s(8). 

[0090] The optimal weighting matrix K(t+1) is calculated from 
the relationship: 

[0091] K (t+1) = A(t)P(t)C T (t)inv(C(t)P(t)C T (t) + R (t)) 

[0092] The covariance matrix P(t) of the estimation error is calcu- 
lated from the relationship: 

[0093] p( t+ i) = A(t)P(t)*A (t) - A(t)P(t)*C T (t)inv(C(t)P(t)*C T (t) + R 
2 (t)) C(t)*P(t)*A T (t) + R x (t) 

[0094] The estimate of the state vector Xest(t) is updated as fol- 
lows: 

[0095] xest(t+l) = f(Xest(t),t) - K(t+l)(y(t) - C(t)Xest(t)) 

[0096] if the condition for estimation was not fulfilled in the first 
process step, the covariance matrix and the state vector 
are replaced in a fourth step as follows: 

[0097] p( t +l) = P(t); 



[0098] Xest(t+1) = Xest(t) 

[0099] For a fuller description of how the Ricatti equation and the 
Kalman filter are calculated, refer to Schmidtbauer B. 
"Modellbaserade reglersystem", studentlitteratur 1999. 

[0100] Output signals from the fourth function block 70 consti- 
tute the seventh state variable s(7) and the eighth state 
variable s(8). Where applicable, the state s(9) correspond- 
ing to an estimated value of the mass is selected from the 
seventh state variable s(7) in a fifth function block 80. 
Where applicable, a state s(10) corresponding to an esti- 
mated value of the gradient of the road on which the ve- 
hicle is being driven is selected in a sixth function block 
90. 

[0101] According to an embodiment of the invention, new esti- 
mated values of switching frequency and interference in- 
tensity of the variation of the gradient of the road are cre- 
ated in a seventh function block 100. These new values 
are input back to the fourth function block. 

[0102] Figure 3 shows the result from running a simulation 

model utilizing the estimating method described above. 
Broken lines represent actual parameter values and solid 
lines represent estimated values. In the shaded areas the 
system was stimulated too weakly, for which reason an 



error in the mass estimate would occur if no threshold re- 
quirement had been laid down. Note that the gradient of 
the road can be estimated even though the estimation of 
the mass is not running. 

[0103] Figure 4 shows schematically a method for estimating the 
mass of a vehicle according to the invention. 

[0104] | n a fj rst method step 110, a measurement is carried out 
of the vehicle's speed for generating input data for a cal- 
culating device. The speed is measured in some way well 
known to a person skilled in the art, for example by a 
speedometer 19 (Figure 1). The speed constitutes input 
data for a calculating device 34 (Figure 1). 

[0105] | n a second method step 120, a measurement is carried 

out of a variable which comprises a longitudinal force act- 
ing on the vehicle for generating input data for a calculat- 
ing device. 

[0106] This measurement can be carried out according to a first 
embodiment via an accelerometer 35 (Figure 1) which 
measures the vehicle's acceleration in a longitudinal di- 
rection and uses this information to determine a variable 
which comprises a longitudinal force acting on the vehi- 
cle. 

[0107] According to an alternative embodiment, a variable is 



measured which comprises a longitudinal force acting on 
the vehicle by recording applied propulsion force f and 
retardation forces f . For this purpose, the calculating de- 
vice uses input signals from the brake control system 20 
(Figure 1) to determine the size of the applied braking 
forces, in particular the size of the force applied via the 
auxiliary brakes. In addition, the input signal from the 
speed sensor 19 (Figure 1) is used to determine roll resis- 
tance and air resistance. In an embodiment of the inven- 
tion, information is used from the engine control system 
16 (Figure 1) to determine torque delivered by the internal 
combustion engine. In another embodiment of the inven- 
tion, the input signal is used from a torque sensor 36 
(Figure 1) placed along the vehicle's transmission line. In 
addition, the input signal from the gearbox control unit 
21 (Figure 1) is used for determining applied propulsion 
force from the calculated or measured propulsion torque. 

[0108] Common to both embodiments is that the longitudinal 
force acting on the vehicle is determined. 

[0109] According to a first embodiment of the invention, in a 

third method step 130 the calculating device 34 (Figure 1) 
generates an estimate of the weight of the vehicle by a re- 
cursive process by using a statistical filter using said input 



data comprising the speed of the vehicle and said variable 
which comprises a longitudinal force acting on the vehicle 
and a statistical representation of a road with varying gra- 
dient. 

[0110] The recursive process preferably consists of the recursive 
process that is described in association with Figure 2. The 
recursive process consists preferably of a Kalman filter 70 
(Figure 2). The process uses the state variables: speed, 
gradient of the road, mass and interference force, accord- 
ing to the equations that are listed on top of page 10. Ac- 
cording to an embodiment, the system matrix of the 
Kalman filter has the appearance that is defined at the 
bottom of page 10. 

The statistical representation of a road with varying gradi- 
ent is included in the system matrix. In an analysis, the 
frequency range of a reference road has been measured. 
Study of the frequency range shows that the frequency 
range can be approximated with relatively good accuracy 
by a first order process. Of course, other processes of 
higher order can be used, with the result that the dimen- 
sions of the state equations increase. 
[0112] As the mass of the vehicle constitutes a state which is in- 
cluded in the recursive process, according to the first em- 



bodiment of the invention, the recursive process gener- 
ates updated approximations of the mass. 
[0113] According to a second embodiment of the invention, the 
recursive process generates updated approximations of 
the gradient of the road. This is carried out according to 
the second embodiment in a third method step 130", 
which is identical to the third method step in the first em- 
bodiment, except that the state corresponding to the gra- 
dient of the road constitutes the state which is of interest. 
As the gradient of the road constitutes a state which is in- 
cluded in the recursive process, according to the second 
embodiment of the invention, the recursive process gen- 
erates updated approximations of the gradient of the 
road. 

[0114] According to a third embodiment of the invention, the re- 
cursive process generates updated approximations of the 
gradient of the road and the mass of the vehicle. This is 
carried out according to the third embodiment in a third 
method step 130" which is identical to the third method 
step in the first or second embodiment, except that the 
states corresponding to the gradient of the road and the 
mass of the vehicle constitute the states that are of inter- 
est. 



[0115] As the gradient of the road and the mass of the vehicle 
constitute states which are included in the recursive pro- 
cess, according to the third embodiment of the invention, 
the recursive process generates updated approximations 
of the gradient of the road and the mass. 

[0116] The invention is not to be limited to the embodiments de- 
scribed above, but can be varied freely within the frame- 
work of the following patent claims, for example the in- 
vention can also be used in vehicles that are propelled by 
engines other than internal combustion engines, for ex- 
ample electric motors. 



